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(57)Abstract: 

PROBLEM TO BE SOLVED: To extend an applicable 
picture range by simplifying a motional condition based 
upon a restriction condition to a three-dimensional (3D) 
rotating matrix and a restriction condition to a 3D 
parallel moving vector. 

SOLUTION: A picture input part 1 inputs two pictures 
obtained by catching a 3D rigid body by a camera, a 
corresponding point detection part 3 detects 
corresponding points between two pictures and a 
reference matrix detection part 3 calculates a reference 
matrix from the 3D rotating matrix R and 3D parallel 
movement vector (h) of the camera between the two 
pictures. In a parallel movement/rotation calculating part 
27, a parallel movement calculating part 4 calculates the 
vector (h) and a rotation calculating part 45 calculates 
the matrix R. A distance calculation part 6 calculates 
distances r, r' between the camera and respective 
corresponding points in the 3D space. In a motional 
condition setting part 1 0, a restriction condition to the 

matrix R and a restriction condition to the vector (h) are inputted by a motional condition input 
part 15 as the motional conditions of the camera. A motional condition simplifying part 16 
simplifies motional conditions to be the restriction conditions of the matrix R and the vector (h) 
based upon respective restriction conditions. 
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g. *»o3 &7c¥ffi£i!)<? h ;U h #Bt*ao 3 &5t2ia 
Wft^tt. Uh#XY¥iB±»l6tc$r4X«ll3«U 
£»S?U { R. h> SSttftft {UR, U 

[0035] (13) : 1515(7) O 3 ^TCtfffifST^iatCiJ 
we. &f®Sttfl9<*, 3<Jc5cEMEfT5«|R36*X«iig 

is. a*o 3 aecTfiiMK? h awno y z^®± 

«?U 3®ftJ^ { R , h> ZiSM&tt- (UR, Uh} IZ 
[0036] (14) : 1*15(7) <D 3 <J:7ntf#gm7^gt:*5 

int. %L<i±ma<7)ig&zmz. 3<%.7tmvmmR& 

Rl : Xtt0SEXYWlimSXZttllIIE. R2 : XlftHIte 
xYWUlte. R3 : XttErtS. R4 : MfcU h 1 : 
3»5c^fa^». h2 : XYTWBISs h3 : YZfB 
9tt. h4 : ZXfWi, h 5 : XYflfi (fit 
JDK h 6 : XWfgW) (Kt*D) . h 7 : Ytti^Sl (fit 

m) t u ifresij^ESs^T^jRfcsi^^^ift^ 

{R, h} 

IR, hi = {Rl, h2) . {Rl, h6K {R 

2, hi), {R2, h2l . <R2, h3l « {R 

2, h4) . |R2, h5l , {R2,h6K {R 

2, h7L {R3, hi > „ {R3, h2L {R 

3, h3l . <R3, h5> , <R3, h6K {R 
3, h7) , {R4,hlK { R4 , h 2 ) <7) 1 7ffl 

[0037] < fisja > mmmzm^< *mwtm 

B1C3W>TRW*. 
(a) : lulS(l) <Wm 

m{&AJ}& 1 5T3i>C7ai!*S:»ifc 2B«SrA 

^1 l , «i5A«iaia5 2 (imrie 2 M*H«9*tfcj5**ait' 

^.^Sr^Td. <Xt=«*«5Wf«»3{4, BiriE2M«ra 

■rs. 

[0038] TWWB • Steff-S^2 7T*J4. 

L. EMEtl««at5* 1 3J>OcllMEff5>JR*9t»-r4. 5g 
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[0039] .1*)*^ SftiSfefl^SB 1 0"C«. *M 

2|cTT?ijGC09{lc0^it 
[0040] 
[&83] 

[0041] zm%mm-f&&>bpM<7>7c 

[0042] 
[»84] 

[0043] £5g*yc p - l«*>*fJ&ai<D2HflLLtf> 

[0 044] 
[SE8 5] 

(£. > 

[0045] izKtb aSdSTWlc J: 0 

[0046] 

[»86] 

{£. } 

[0 04 7] fcffiEU a*f?WG*:fcft4WJI8i3W& 
(b) : HfTf£(2) O^ffl 

1fflEaHbAtt&£tfl Otli, att*#A*«l sici 
Sttfcfefk Sl^3»5c¥^ijK<.^h/UhO$!l*!^fr$- 
frA^gB 1 5 #7Jj Ufc 3 JtercEMEIf WROM«J*fr. 

[0 04 8] (c) : BUffiO) CO#ffl 

mmmg&Ajj&i 5ti. itnes^TciHiig^iRosij 

• XttHH£xYttHHKXZ||liIlI!|S 

• XttEBS. YW1EH6. Z*ISR<0P«3. g$r£2otf>£ 
j£ ' 

• XWEHE. YWHSg. ZWHHSOrtOl-p 

• mzcm&nmmm 

02 l«9^-fix*>£A*-t-g>J:;H^ ii*E3&7c¥ 



[ 0 0 4 9 ] (d) : WE(4) Of£fB 

±0. 3<^7C[Hl!|&ff?ljR<7)$l|^fr$-, 

• XttHtexYttlllKxzWIalK 

• XtMslftxYttlsie 

• XttEte 

[ 0 0 5 0 ] (e) : 1ME(5> Oflsfli 
«IB»tt^1WWKl 6"Ctt, hW*fj*frfBtt»18t= 

io. xwniKxYmiiii£xzw[iifec7)*»iiiK. sbu 
me. @^u<^>#R<oiwtt*frt=«tT» x, y, z 
s&n&mmmgMZft^. 3<^£fti<7)**n^ft. ma 
mt. xYfffli«*ftfi, mamss. xm±.<vma 

»HME, BE»EBE^ROj»fcfettfc:*tLT» Y, ZW 

ft. YZfI±i7)*ttfi, Kftl9tt« Y«1±«0BI»# 
ftc7)=S-h <7)ffl$}£#Hz2mt h . 
[ 0 0 5 1 ] (f) : WE (6) Of^ffl 
«TEh»JttjWWB»W»18tt, mrte3<X7c¥^ft<^ 

UmizX *) . ffiiittLh^BtS^ft-Cfcl. h^fgfei^feff^ 

[ 0 0 5 2 ] (g> : OTE<7> Oflsffl 

Wtofkft { R, h) fc»U U s V£St*acD3<?;7n!H]3S 
ffWfc SUSSfttJ: OSft^fr (URV, U 

h> teS&W*. 

[0053] (h) : WE<8) COf^ffl 
H9Em^Affil9U. 335c®(lKfTflRjWtt»$rS> 
if. M-mm* I fc ilft^ < R. h ) ZM 

m&ft { i . h> tcsaw*. 

[00543 (i) : 1512(9) CDf£ffl 

Wh = xlMiffi^Wl'fcfc4 3iJC7ainefi ! 
flWfcJBWC. Sft-fctt {R, h > Srilft^tt (Wh, 

xmwsLi? v>v)iz$zm-h. 

[005 5] 0) : WE(H»*>fls/B 
m8affiK»Atf 3»5c[lMS1f5ijR*tXttIl«Ex 
YWIUte. *»o 3 acjc W^ft^ ^ h ;U-h ^'KE^IO 3 & 
7c£fa*£»<7)i§-£(±. U h **X Y¥B5±?£fttC&§ X# 



(26) «if9-2 3.7 34 1 



0|gU£giKU SUgfett <R, h > SrSift^fr < U 
R, Uh } 

[00 56] (k) : HUie(lDO#ffi 

mmwm&m i9it 3 ^tcehs^ r#x*iiehk x 

YttM. ^3<Wcfff^lK^ h;Hi#Bt»OYZ 
¥®±^l&£>*§1^±. Uh^Ztt±^»l^^X«l[lI!|S 
U£3StRU <R. h> Z-m&fr {UR, U 

h> tC^-T^.. 

[0 0 57] (1) : BUiS(12)^ffl 

mzmma&Bi 9i±. 3^7cH3iK^jR^xttniis. 

fr-o 3 ^TtWn&m^? h>Uh tfBBBCD 3 &7u£fa^» 
Uh^'XY^ffi±^|j)^|,X!tt[lI!iSU^S 

JRU Si&^MR. h> ^aU)#;fr { UR, Uh} iz 

[0 0 58] (m) : lwiB(13)0#ffl 
fTf £S S^ftge 1911 3 ^TClHlKfi 1 ^ R#X«i[3l£. 

Uh*iYWJi^«jtC^§XWlIn]teU$-atf? 
U SUfc&f* <R, h} £3IijH&# { UR, Uh) t3fc 

[0 0 59] (n) : lufe(14)0#ffl 

U ^L<«ifiBDc7D^Sr^^. S^TnEHIS^jR^ 
S&T&W^ilr^ hJUhCDZtl^tllZttl,. Rl :X 
ttBtexYWHIKxZttlsIfe, R2 : X$fc®fcx YttHI 
fi. R3: XWImUk. R4 : 0l££tU hi : 3&7c£ 
E^ttk h2 : XY¥ffi#Bk h3 : YZfffift. h 
4 : ZXflfS, h 5 : XYfiSgi (BEfcJ) . h 

6 : x$mm (sea) . h7 : y$mm (gen) t u 

tchmigkVc* { R, h } t { R, h } = 

{Rl,h2K (Rl, h6L '(R2, hlL 

{R2, h2K (R2, h31 , (R2, h4l . 

(R2, h5L (R2, h6K (R2, h7) , 

<R3, hi), (R3, h2l, <R3, h3> . 

(R3, h5> . (R3. h6) , <R3, h7> s 

{R4,hlK (R4. h 2 ) <D1 7 1B03Bt0ktfr> 

8 

S M k G* = 0 

k-l 

[0 0 70HR^ttt. 
[0071] 
. [89 1] 

G* (k=l, • • 9) 
[0072] {i«aSSttA-C*4fc», »8i« 

[00 73] 
[892] 



^•mtHzgrn-tz. 

[00 6 0] (o) -. PXtco J: olzLZ. 8flJ: OfKr^ 
[006 1] 

§ i : m*m%*m<7)mw 

< . mtotkft-nnftotfb zzt tfmftT'b & z t izmm 

U S»^#5:fiJfflLT8®*M^^-C'3^7ca7C 
[00621 aaWfefrSrfflV^-CSWfWG^SW-r*- 

®mmz&.com*)x-hz>. m^2-nm^x. g= 

( gij ) s mij = m ai in a j' (i, j=l, 2, 3 ) t 
B&i&hSb* #<7>5£3-0£#S <m ai : m a ^7 
h/K7)i . 
[0063] 
[88 7] 

8 8 

2 2 mugu=0 5S3-0 

i-i j-i 

[oo64] &&nmGcommsii ( i , j = 1 , 2 , 

3) * 
[0065] 
[88 8] 

G k (k=l, • • 9) 

[00661 iL.Mm^ (i, j = 1 , 2, 3 ) Sr 

[0067] 

[88 9] 

M k (k=l, • • 9) 

[00 6 8] tmttdm&G&h. 

[0069] 
[89 0] 



^3-1 

G„ (k=l, ■ • 9) 

[0074] (ilSMt^JKT'JbS^. fc*^v%. dcoSf. 

[0075] 

[89 3] 

Gjc (k=l, • • 9) 
[007 6] £&<^3-2cOiol;:9fIJ: Di^t^ 
[0077] 



• 
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[R9 4] 

g_i (i = 1. • • • p ; p<9) 



[00 78] fcURfflRHTC-**. 

[0079] 

[R9 5] 



G k =2 a kij gi (a kl :5S&) 



^3-2 



[0080] 

[R9 6] 



[ o o 8 1 ] <Df*k i oUjgsrc* . m&i 3 - 

p 

2 mi _g , =0 
I -I 



[0082] 
[R97] 



5$3-3 



CfcfcU mi £ 

k- 1 



Mt aid (i = 1, 



P) ) 



[0083] mffS^3-3vC*3V>T, 

[0084] 

[R98] 

mi 

[0085] iaaV£»t> . 9<Itf)5fc*n^RS:f*o»a 

^s^Tfcs«rE5C3-iti. pxiip-im<n*m% 
»*j*-aBffl*e*T*4 mrie^3 - 3 tcflwrr* & . 
5^«2r-^tf^-Ji. p - 1 Oioaadsrsstjwv^a 

fc, I g I «V2i::iESfc-*-4. ft->T. f&HfcttJEjft 
WiP - 1 £ k . 

[0086] iwfa*jyia> (f&fePHBB) i±&o «t 5 
s. 

[0087] 
[R99] 

mi ( i = 1 , • • • p) 

[0088] *tmLxp-ia?mmm&j]m& <w 

15^3-3) 
[0089] 
[Rl 00] 

[0 0 9 0] sS 
[00 9 1] 
[Rl 0 1 ] 



St 



[00 92] Sr*3- 
[00 93] 
[Rl 02] 



[00 94] l2R<Og5rt-£>&r i;js h <7)gfirT$> & h 
© (fi£*09#M) teiJWC, hu R. r, r' 



[0095] § 2 : 3<X7nW#«7niiaogiBJ ■ • • 0 
2#S5 

ism( *<r> i ) t$> o » Aa{daaft*fl«seaw)^w« 

BHI±iBB*frfB«WIJi0fllJSBI'r'*4. 04123- 

2-04 ci^ %Tiotow»<oiaH(iia(cov ^xmm 
•rz. 

[0096] m^cox o t=3<*5cfli««7asm:ii, a 

lOt. H«A*Sff 1 k , »C^E«aj» 2 

jn»53&»<?»4*¥ff»«i • 0®w»2 7 1 . Emm's. 

&6k. "f-^mtfSl HfcWft»t"t&4. 
[ 0 0 9 7 ] * LT. flff£Sb&ttK£&K 1 OCIt 3 
15t. aBtefefflfittS 1 6 #K»1T ft 

»»17fc. hffl*fcfefMB*Mlt 1 8 k , ffiH^j&gB 1 9 

£352 1 fc . 2 2 jWRf-JT» 0 > 

fr^wf** 3 tea, m^mssaam 23 1. mmz 
mmm 2 4t. mttmmmmm 2 5 mhk * 
a. 

[00983 mrie««« 3^7ct»fSm7C^S^»^li<?: 
[0099] £*ft?i|fttUK 3 USK^KJgffi 1 0 X' 

• i°i«if-jtiR2 7-eti. jUb&fttt£tfi otr 



(28) ^ «fHf9-2 3 7 34 1 



«tw»2 7<osnBfi*. Rzmtm&& 6 mt&mm 

fir- 9Wsm 1 1 {c^SW & . 

t o i o o 3 ijeaBtefewt, xM&fHK&ff i ot 
\,\ hmttoktmmi i 8*3tt7ewTSft<? wni 

[01013 »J&Sl*H*2TfcJU 3Bft*fl«3eSB 1 0 

wsggs 2 1 \i&m%nmjm. p - 1 £**vc » *«&sr 
i i$mfijm&fe& 2 2 ^i* h . ttJGMAM9(Sff 2 2 

[01023 mne**?fT^JW-s[S53(i. aon^ftMat 

5BRBHl»2 3T'{i. *ttTfl|Gtf>JBIf 
[0 1033 
[Si 033 

{Gk } 

[0 1 043 **/K>8ER 
[0 1053 
[»1 043 



[0 1 063 K:«rlE*3-20iaKaBIW*. BURS 
Sff-»SB2 4«i. WiBjiSl«taj*2*»fe2t6*i.fc»JE^[flE 
ftefflwciBSSesi: (S3 -3 ) <0«S 

[0 1073 

[Si 053 

ffii (i = 1, • • • p) 

[0 1 083 £H-3£LT . p - 1 flOtt£%fc&S3£ 
(3S3-3) fcWWC 
[0 1093 
[SI 063 

[01103 . m^mmmmnu 2s\t.m 

[01113 
[SI 073 

(G k } 

[0 1123 £3i3-2lz£ Srfc. JWWW: 

M*«j*fr*^-i 4>*ifc»*. ffirfES 3-2 zmtz-tmw 

[0 1133 
[SI 083 

gj (i = l, • ♦ p) 

[01143 i^&—amtci3mi<k0M r )'ct>&. 

[0 1153 
[SI 093 



Gu (k=l, 



■. 9) tgi (i = l, 



P) 



. [o 1 1 6 3 z®.m£.mcommtM,%Lx. wm&ffio [01173 

a»*fflV^ftfc x WIl . «H2£5r£ft. [SI 103 

(s. } ©S/J«pl±G k (k=l, • 



•» 9) 



[01183 <o*&a4£*T**. -ron*. 

[0 1193 

g. (i = l. • 



[SI 1 1 3 

% p) tiG* Ck=l, • 



, 9) 



[01203 nmsm&x-hh mmim^-rh > . 

ffrS2 :1MErt3-2fc:ttlrVC. 9ff p50<OjaWf5(A 
Sr. {a ki > (k = l. • • -9. i = l, ■ • • p) 

[01213 
[SI 123 
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rGi -| 
• 




- g_> - 


• 


=A 


• 


-G 8 - 




Lg, -J 




g.» 


Ci = 



[0 12 2] T'£>£>#>\ 
[0 123] 
[SI 1 3] 



p) ^^SSStot"^ rankA=p 



ft&tf, G* (k=l, • - 

[0124] nmm&smtpx'hh (mmt^-t 

[0 12 5] 
[iiCl 14] 

{g, } « {G* } 

[0126] <7)&%m£.%7t<Dmmzm lw ^t, 

[0 127] 
[»1 1 5] 

{G_ k I 

[0128] Of&SSJ&fcTC^ffl&fctf UMBK* 3 - 

2£st*rr 

[0 129] 

mi i6] 

(g_, J 

[0 13 0] &-£#>tH£&^. 

[0131] 

[&1 17] 

(g i } (G k } 

[0 1 3 2] <?>%kmmL%m*M-£b LXt&Zt it* 

[0 133] 
[&1 18] 

{g, } it {Gv } 

[0134] cr>mwj&i!rT'h&frt>. zcosmx-m-rz 
ttfx-Zh. B?rlBi&S2^<b, 

[0 13 5] 
[&1 19] 

{gi } tiismk£re&^ miA= {a k ,} 

[0 13 6] cr>yy7tf P X'$>&Zk£tr?£lf. 



9) 

[0137] 
[SI 20] 



{g. } 



[0138] *\ft>JMIST'£> & Z t tfm £ h . 

mm 

m^hum^.mznLx^mx'hh. G=hxR-e£> 

%><r>x-ihh . mte<nwh\zm-m\fo^\i*m. 
izh&tp. RmmciMMiktt-k lx. "immzm^K 
a»^#" zm. ar. mz" mmmiz^tzmm^ 
***u i 5 3<DU^fti^mnzmmcoi i 
<r>mgkmzimz*th. 

[0139] mftB "mmmz&.^tzsm&tt-" s-wtc 

•gmth. ZCDWrit. 3<%Kgmi,ZXYZmm$:kh. 
»^?WWht±e&S2£f#o^ RfchOgE&Jg£»: 

[0140] r : wzmmpm o^embo^is. 4fc 
R<mm3kM±&.<r>2 vm*)X'hh. 

[0 14 1] ■ XWElKxYlttlllteXZWIlIte 
[0 14 2] • 3&7c£0^1!j 



(30) 



7 [0 144?'- X«®«^«*« XZWMe 



^¥9-2 3 7 34 1 
[0 1451 

C^l 1 ^«^..-bh^- i**«!fc<* 







X, Y. Z 


XttHS* Y«0*x ZttElC© 
BE*!®* 







[01461 |«l«lltt«» rt -* l4l,h 

[01471 
[*2l 







X, Y, Z 


XWiOBtW^^ 


Y. Z 


g; 1 no 5 -otDSflt^fr 



\oi48l^^^«^f c 
lo'l 491 ftf . ^^Sr^L-C-^-^ 

****** 1-*=**. ^^; ± iUi 

To 1501 tfeB3 :«*!** { ^^ ± " M i| 



* {U RV, Uh) (C-*t*. ^TrS«** 



/ 



(3 1) 



#^¥9-2 3 7 34 1 



[0153] ffigMtZttosfcaOBAft 1 5 3ffliiiiW)* 

3ic^t^ 1 7 mcommgkftcoi ^-rtuj^tmmx-h & z 

[0 154] 
[^3] 





h 1 


b 2 


h 3 


h 4 


h 5 


h 6 


h 7 


R 1 




O 








O 




R 2 


o 


O 


o 


O 


O 


o 


O 


R S 


o 


O 


o 




o 


o 


O 


R 4 


o 


o 













Rl : X«l§]|ExY«l|H|<ExZtt|aHE, 

R 2 : X#Hl«KXYtt|aJ?E, R 8 : X«SUS; 

R 4 : EUEft U 

h 1 : 8*5c£Hi*B). h 2 : XY^Fffi^ft, 

h 8 : YZfMtt, h 4 : ZX^ffi^Il. 

h 5 : XY¥W$» (K551) , h 6 : XttgB (BEAD , 

h 7 : Ytt»» (BESJ) 

[ 0 1 5 5 ] § 4 : A«£«K J: S 3&7C«tc»?)«8I £ "3 tC*4 . fcfc'U GO i j gij . RWi j« 

17 mommgkmicr) 3 KtcStcKov >TK W [0156] 

S4. G®&&£i&m8i&tzft'j>mR07ci:&mtztt&&m 









R 1* 


h 2 


GO 9 










8 




Rip 


h 6 


g XI, 


g Hi 


gii. 


giu 


gll* 


gii 


5 




R2, 


h 1 


G© 9flKZ>5c 










8 




R2, 


h 2 


GO 9<H<Z>5g 










8 




R 2 r 


h 3 


g i if 


g hi 


g u. 


git, 


g II* 


gii* gii 


6 




R2, 


h4 


GO dm<D7b 










8 




R 2, 


h 5 


g 1 u 


g 11. 


gn. 


gll. 


8 11* 


gii 


5 




R 2, 


h 6 


git* 


git, 


g 11, 


g 1 1* 


S 11* 


gn 


5 




R 2, 


h 7 


g 1 u 


g 1 if 


g 11, 


gll. 


£11 




4 




R 3, 


h I 


g Mr 


g ii* 


g 1 1, 


g IX, 


g ti* 


gii 


5 




R 8, 


h2 


g II* 


gn« 


g »»• 


gll* 


git 




4 




R 3, 


h 3 


S II* 


g ii* 


g 11, 


gll 






3 




R 3, 


h 5 


r 11, 


r i«, 


1 c^a) 






2 




R 3. 


h 6 


r ix, 


r 11 










1 




R 3, 


h 7 


r it, 


r it. 


1 csa) 






2 




R4, 


h 1 


hi . 


h, , 


h. 








2 




R4, 


h 2 


h, . 


h. 










1 





[0152] R#X«iEM&<9*£U; % hjMWaK>53ifc7n 

Y¥B±^£fOTHfrc* s . h imssm y zw-m±w 
»*>*&li. US-SS^Xttimifcr-rSi:. h£YW± 



[0157] -®.cr>Wr&kmm3kft < R 1 , h 2 > . 
(R2, hlL { R 2 . h 2 K { R 2 , h 4 } C9*§ 



[0158] Kfffi*4 ttBtt&fHgtC 3&5cflec*=*MI 
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MftttOW. 3Stfk (Rl, h2L (R2, h 
1), {R2, h2K <R2, h4l S:il*13^ 

WHUfc. 

[0 15 9] ffiUnXolz^ 5 3iiD^a»^ 



[ 0 1 6 0 ] (1) : 3<^7Clliefi : ?iJR = R 1 Oi§-& 

3«Dcnite^jR=R i tiawss-eatsfi* . 

[0161] 
[ftl21] 



Ri) r= {xmm x (ywubb x {zmm 

rl -l rC0 -Sfl-i rC0 -SO -i 

CO -SO 1 S<* CO 

L co J Lse c$ J L i J 

[■ 



[0162] (2) 



ce 

=|-S0 se 
co se 

mfflkft < R l ■ 



c<t> -ce 
c<p+c<p so so 

C<fi+S$ S0-C0 

h 2 > <?)t§r£ 



[0 163] 
[ftl 22] 

h2) h= {XY¥E8ai} =|h!l. |h| = l 



se s^+c^ cost ce\ 
se so+so co ce-* 

(4) : 3<K7ClinRfT*lR-R2tf>*£ 
3<5^cIl]!lSfir^JR = R 2 . 
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